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Shortest Paths of Bounded Curvature for the Dubins Interval 

Problem 
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Abstract —The Dubins interval problem aims to find the 
shortest path of bounded curvature between two targets such that 
the departure angle from the first target and the arrival angle 
at the second target are constrained to two respective intervals. 
We propose a new and a simple algorithm to this problem based 
on the minimum principle of Pontryagin. 

I. Introduction 

Path planning problems involving Dubins vehicles have 
received significant attention in the literature due to their 
applications involving unmanned vehicles 0-0- A Dubins 
vehicle 03 is a vehicle that travels at a constant speed and has 
a lower bound on the radius of curvature at any point along its 
path. The basic problem of finding a shortest path for a vehicle 
from a point at (xi,yi) with heading 6 \ to a point at (X 2 , 2 / 2 ) 
with heading 62 was solved by Dubins in and later by 
authors in 0, 0 using Pontryagin’s minimum principle 
0- This article considers a generalization of this standard 
problem called the Dubins Interval Problem and is stated as 
follows: Given two targets located at (x\,y\) and (X 2 , 2 / 2 ), 
respectively, on a plane, a closed interval 0i of departure 
angles from target 1, and a closed interval ©2 of arrival angles 
at target 2, find a departure angle ()\ € ©i, an arrival angle 
02 £ ©2 and a path from (xi,yi,0i) to (x 2 ,y 2 , 02 ) such 
that the radius of curvature at any point in the path is lower 
bounded by p and the length of the path is a minimum (refer 
to Fig. [TJ. 
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Variants of the Dubins interval problem arise in search and 
attack problems 0.0 where a vehicle must reach a target 
such that the arrival angle of the vehicle at the target must 
be within given bounds. The Dubins interval problem also 
arises while lower bounding Traveling Salesman Problems 
(TSPs) involving Dubins vehicles (20). In [20), the lower 
bounding problem was posed as a generalized TSP where 
the cost of traveling between any two nodes requires one 
to solve the Dubins interval problem. The Dubins interval 
problem was solved using calculus and some monotonicity 
properties of the optimal paths in pO) . In this article, we give 
a simple and a direct algorithm using Pontryagin’s minimum 
principle | l_7j[. The application of the minimum principle leads 
to an additional set of complementary slackness conditions 
corresponding to the angle constraints at the targets. The key 
contribution of this article lies in interpreting these conditions 
and characterizing an optimal solution to the Dubins interval 
problem. Similar to solving the standard Dubins problem, 
an optimal solution to the Dubins interval problem can be 
obtained by simply comparing the length of few candidate 
solutions. After proving the main result for the Dubins interval 
problem, we also solve the special case of the Dubins interval 
problem where the departure angle is given at target 1 while 
a closed interval of angles is given at target 2. In this special 
case, the objective is to find an optimal Dubins path and the 
corresponding arrival angle at target 2. 

II. Notations 

The two targets lie on a ground plane and the motion of 
the vehicle also occurs on the same plane. As commonly 
assumed, any angle measured with respect to the x-axis in 
the counterclockwise direction is positive. The interval 0/, : 
at target k is defined as ©& = [0™ m , 0j? ox ] C [0,27r] with 
Qmin < gmax p or p _ ]_ f 2. Given an initial configuration 
(tci, yi, (9i) and a final configuration ( X2,y2,02 ), L.E. Dubins 
0 showed that the shortest path for a vehicle to travel be¬ 
tween the two configurations subject to the minimum turning 
radius ( p ) constraint must consist of at most three segments 
where each segment is a circle of radius p or a straight line. 
In particular, if a curved segment of radius p along which the 
vehicle travels in a counterclockwise (clockwise) rotational 
motion is denoted by L(R), and the segment along which 
the vehicle travels straight is denoted by S, then the shortest 
path is one of RSR, RSL, LSR, LSL , RLR and LRL or a 
degenerate form of these paths. For example, the degenerate 
forms of RSL are S , L, R, RS, SL and RL. We also subscript 
a curved segment in some places ( L^ or R,: : ) to indicate the 
angle of turn (ip) in the curved segment. In the results stated in 
the ensuing sections, the open interval 0 ™ ax ) is denoted 

as Q° k for k = 1,2. 


III. Main Result 


subject to 


Theorem 1. Any shortest path which is C 1 and piecewise 
C 2 of bounded curvature between the tw’o targets with the 
departure angle 9d £ 0i = [0™", 0] at target 1 and the 
arrival angle 8 a £ ©2 = [0™ OT , 9Vf ax ] at target 2 must be 
one of the following or a degenerate form of these: 


Case 1: S or L^ or or L^R^ or R^L^ with i/j > n. 

Case 2: 9d = 0™ ax and 9 a = 9f iax and the path is LSR. 

Case 3: 9<i = 9™ ax and 9 a = 0™" and the path is either 
LSL or LR^,L with f) > it. 

Case 4: 9d = 9™ ln and 9 a = 0™ m and the path is RSL. 

Case 5: 9d = 0" un and 9 a = 8™ ax and the path is either 
RSR or RL^R with i/j > n. 

Case 6: 9d = 9 r f ax and 9 a £ @2 and the path is either LS 
or LRy, with f> > it. 

Case 7: 9d = 0™ n and 9 a £ ©2 and the path is either RS 
or RL^, with f> > tt. 

Case 8: 9d £ 0° and 9 a = 9f Lax and the path is either SR 
or L^R with f> > tt. 

Case 9: 8d £ 0° and 8 a = 9f lln and the path is either SL 
or R^L with > tt. 


Remark: Note that in cases 1 and 6-9, the departure and 
arrival angles are implicitly specified by each of the paths. 
For example, if L^R^ with i/j > n exists between the two 
targets, as the length of the segment L is equal to the length 
of the segment R, the departure and arrival angles are simply 
specified by geometry (we will later discuss this in the proofs; 
refer to Fig|2]i. Similarly, if 9 d = 9\ nax (case 6), the arrival 
angle at target 2 is determined by the LS or LR paths. The 
only remaining part would be to check if the arrival angle at 
target 2 lies in the interval [9™ m ,9™ ax ]. If it does, then the 
corresponding path is a candidate for an optimal solution to 
the Dubins interval problem. 


IV. The minimum principle 

Let v a be the speed of the vehicle, and u(t) denote the 
control input for the vehicle at time t. Let x{t),y(t),6{t) 
denote the position and angle coordinates of the vehicle as 
a function of time on the ground plane. At time t = 0, let 
the vehicle be located at Let the travel time of the 

vehicle be denoted by T. Note that 9d = 0(0) and 9 a = 9(T). 
The Dubins interval problem can be formulated as an optimal 
control problem as follows: 


min 

«(t)e[-i,i] 



( 1 ) 


dx 

dt 

dy 

dt 

d9 

dt 


v 0 cos 0, 

v 0 sin0, 
u 

5 

P 


and the following boundary conditions: 


a;(0) = x-i, x(T) = x 2 , 

2/(0) = 2/u y(T) = y 2 , 


( 2 ) 

(3) 

(4) 


0min _ 

(5) 

0(0) - 07 iax < 0, 

(6) 

0mm _ 0( T ) < 0j 

(7) 

0(T) - 9^ ax < 0. 

(8) 


Let the adjoint variables associated with p(t) = 
(a;(f),t/(f),0(f)) be denoted as A(f) = (A x (f), A y (f), A 0 (f)). 
The Hamiltonian associated with above system is defined as: 

u 

H(A,p, u) = 1 + v a cos 0Aa; + v 0 sin 0A y H—A g, (9) 

and the differential equations governing the adjoint variables 
are defined as: 


dA x 

dt 

d\ y 

dt 


= 0 , 


= 0 , 


—— = u o sin0A x — v 0 cos9X v . (10) 

dt u 

Applying the fundamental theorem of Pontryagin HD to 
the above problem, we obtain the following: If u* is an 
optimal control to the Dubins interval problem, then there 
exists a non-zero adjoint vector A(f) and T > 0 such that 
p(t),A(t) being the solution to the equations in |2]) and © 
for u(t) = u*(t), the following conditions must be satisfied: 


. Vt £ [0,T], H{A,p,u*) = min ue [_ 1)1] H(A,p,u). 

. Vt £ [0, T], H(A,p,u*) = 0. 

• Suppose ai, a 2 , /3\, f3 2 are the Lagrange multipliers cor¬ 
responding to the boundary conditions in <[5]»-(j8]) respec¬ 
tively. Then, we have. 


Oil, OC2, Pi, P2 > 0, 

(11) 

a 1 (0i‘ <n -0( 0)) =0, 

(12) 

a 2 (0(o) - er x ) = 0, 

(13) 

(3i(9™ in — 9(T)) = 0, 

(14) 

/3 2 (9(T) - 9^ ax ) = 0, 

(15) 

A e{T)=p 2 -Pi, 

(16) 

Ae(0) = ai\ ~ Oi 2 . 

(17) 


Given a departure angle at target 1 and an arrival angle at 
target 2, the following facts are known for the basic Dubins 
problem in fl5), fl6). We will use them in our proofs later. 


Fact 1. Consider any point P on an optimal path which is 
either an inflexion point of the path (point joining two curved 
segments or a point joining a curved segment and a straight 
line) or any point on a straight line segment of the path. 
Suppose the vehicle crosses this point at time t £ [0,T]. 
Then, A g(t) = 0. 


other constraints in the table can be verified using a similar 
procedure. Hence proved. 

■ 

We now use the constraints on Ag(0) and A g(T) to infer 
the candidate solutions for the Dubins interval problem. 


Fact 2. All the points of an optimal path where A g(t) = 0 lie 
on the same straight line. 


Lemma 2. Let Ag(0) = A e(T) = 0. Then the optimal path 
for the Dubins interval problem must be either S or Lp or 
Rp or LpRp or RpLp with ip > n. 


Fact 3. Consider any curved segment of an optimal path. 
Let the times f i, t 2 be such that 0 < 1 1 < t 2 < T, the 
vehicle is located on the curved segment at times t \, t 2 , and 
Ae(fi) = A e (f 2 ) = 0. Then, the length of the curved segment 
between the times t\ and t 2 must be greater than irp. 

Fact 4. For any t £ [0, T\, the optimal control 

u*{t) = -sign(\ e {f)) if Xg(t) ± 0. 


V. Proof of theorem Q] 

The departure angle in any optimal solution must either 
be an interior point in 0i or belong to one of the boundary 
values of 0i. Similarly, the arrival angle in any optimal 
solution must either be an interior point in 0 2 or belong 
to one of the boundary values of 0 2 . The combination of 
choices for the departure angle and arrival angle coupled 
with the complementary slackness equations in CM3 
provides constraints for the values of Ag(0) and A g(T). These 
constraints can then be used to find the candidate solutions for 
solving the Dubins interval problem. The following lemma 
first shows the relationship between the departure, arrival 
angles and the constraints on Ae(0) and A g(T). 


Lemma 1. The constraints for the adjoint variable \g at 
times t = 0 and t = T corresponding to the departure and 
arrival angles are given in the table below: 


Case 

No. 

Conditions on the departure 
and arrival angles of any op¬ 
timal path 

Implied constraints on 
Ae(0) and A g(T) 

1 

0(0) € 0?, 0(T) £ 0? 

Ae(0) = 0, Xg(T) = 0 

2 

0(0) = erf 0(T) = er x 

A@(0) < 0,A g(T) > 0 

3 

0(0) = erf o(T) = er n 

Ae(0) < 0, Xg(T) < 0 

4 

0(0) = er n , e{T) = er n 

A e (0) > 0,A g (T) < 0 

5 

0(o) = erf e(T) = er x 

A e (0) > 0,A e (T) > 0 

6 

0(0) = er x , 0(T) G ®° 2 

A e (0) < 0, Ae(T) = 0 

7 

0(0) = er n , o(T) £ ©2 

Ae(0) > 0, Xg(T) = 0 

8 

0(0) g 0?, 0(T) = er x 

Ag(0) = 0, Xg(T) > 0 

9 

0(0) £ ®f e(T) = er n 

Ae(0) = 0, Xe(T) < 0 


Proof: Consider the first set of conditions, 0(0) £ Q°, 
9(T) £ ©g, in the table. If 0(0) £ 0°, then equations ( fl2| ) 
and ( fl3| imply o i = 0 and a 2 = 0 respectively. Using m 
we obtain Ag(0) = oq — a 2 =0. Similarly, if 6{T) £ ©l), then 
equations ( fl4| and ( fl5| imply 3-\ = 0 and fl 2 = 0 respectively. 
Using ( fl6| ), we obtain A g(T) = /3 2 — /?i =0. Each of the 


Proof: An optimal path can just be a straight line from 
fact [2] From fact [3] a curved segment of length greater than 
■np can satisfy the boundary conditions Ag(0) = A g(T) = 0. 
In addition, any path containing three curved segments and 
satisfying the boundary conditions must have the length of 
each curved segment (between any two inflexion points) 


greater than ■np\ however, as shown in |16|, such a path 


cannot be optimal. Therefore, an optimal path may consist of 
either one or two curved segments with the length of each 
segment greater than tt p. 


If an optimal path consists of exactly two curved segments, 
then there are three points ((an, yf), (x 2 , y 2 ) and the inflexion 
point) where A g(t) becomes zero for t £ [0, T], From fact 
[2] all these three points must lie on the same straight line. 
Therefore, the length of the first curved segment must be equal 
to the length of the second curved segment as shown in Fig. 
[2] (in this case, 0(0) = 9{T)). 



Note that a set of constraints, say Ag(0) < 0, Xg(T) > 0, 
can be satisfied if either Ag(0) = A g(T) = 0 or 
A e (0) < 0, Ae(T) = 0 or A fl (0) < 0,A g{T) > 0 or 
Ae(0) = 0, A g(T) > 0 is satisfied. The following lemma 
identifies all the candidate solutions for any combination of 
these constraints on A@(0) and A g(T). 


Lemma 3. Candidate optimal paths for the Dubins interx’al 
problem corresponding to the constraints on Ag(0) and Xg(T) 
are given in the table below: 







Constraints on Xg (0) 
and X g(T) 

Xg(0) = 0, A g(T) = 0 

A fl (0) < 0,A 9 (T) = 0 
Afl(0) < 0,X e (T) < 0 
A e (0) < 0,A s (T) > 0 
Afl(0) = 0, Xg(T) < 0 
Afl(O) = 0, Xg(T) >0 
A e (0) >o,A e (r) = o 
A e (0) > 0,A g(T) < 0 
Afl(O) > 0, A e (r) > 0 


Candidate solutions 
(ip > n) 

S, L fjj, Rjjj, L Rjj}, R-i/j L ^jj 

LS, LRp, with ip > it 
LSL, LR^L with ip > n 
LSR 

SL, RL^ with ip > 7r 
SR, LR^ with ip > it 
RS, RLp, with ip > n 
RSL 

RSR, RLp,R. with ip > it 


Proof: The candidate solutions corresponding to Ag(0) = 
A g(T) = 0 has already been shown in lemma [2] Consider the 
next set of constraints Ae(0) < 0 and A g(T) = 0. If Ag(0) < 0, 
the first segment of the path must be L (fact [4j>. LSR^ or 
LSL^j, with ip > 0 is not possible because this path would 
violate fact [2] unless the length of the straight line is equal 
to 0. LRL is also not possible because the length of the R 
segment and the last L segment would each be greater than 
7r p which then cannot be optimal m- Therefore, the possible 
candidates are LS or LR, : . with ip > tt. Each of the remaining 
set of the constraints can be shown using a similar procedure. 

■ 

The theorem follows by combining lemmas □ and [3] 

VI. Solution for the Special Case 

In this special case of the Dubins interval problem, the 
departure angle 9d is given while the arrival angle at target 
2 must belong to a closed interval @ 2 . 

Theorem 2. Any shortest path which is C 1 and piecewise 
C 2 of bounded curvature between the two targets with 
the departure angle 0d at target 1 and the arrival angle 
9 a £ ©2 = [9™ ln ,9™ ax ] at target 2 must be one of the 
following or a degenerate form of these: 

Case 1: The path is either LS or RS or LR^ or RL,;. with 

Ip > TT. 

Case 2: 8 a = Of 10 * and the path is either LSR or RSR 
RL.p,R with ip > tt. 

Case 3: 9 a = 9f lm and the path is either RSL or LSL 
LR^L with ip > tt. 

This theorem can be proved following the same procedure 
as in the previous section. 
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